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DISTANCE SENSOR HAVING A COMPENSATION DEVICE FOR A MISALIGNMENT 

ANGLE IN A VEHICLE. 



TftepesMt^ 
Background Information 

|||sl|ffij||Hi|S 

a|i^ In the case of speed regulators having a distance 

sensor (Adaptive Cruise Control, ACC) adapting travel speed of a motor vehicle to slower 
vehicles traveling ahead, when these are detected by the distance sensor, is already known. 
However, the distance sensor has a limited detection range, and thus can only detect such 
vehicles as are located in the prospective course range of the following vehicle. A 
misalignment of this detection range, which can occur either during installation on the vehicle 
or during operation, has the effect, however, that the longitudinal axis of the distance sensor 
relatively to the nominal alignment (center line of the vehicle) has a systematic angle of 
deviation. This can have the result that this misalignment, for example, leads to a faulty lane 
assignment of a detected radar object on the path of motion of the motor vehicle (trajectory), 
that is, to a vehicle being followed or coming in the opposite direction, and that thereby an 
undesired reaction of the speed regulator can take place. 

A compensating device is known, for example, from German Published^ Patent Applic&ioni 
No. 1 97 46 524 {AI J, for compensating for the installation tolerances of a distance sensor in a 
vehicle, in which the installation tolerances of a distance sensor are compensated. Using an 
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electronic evaluation device, current object distances and a current object angle are measured 
during travel, for detected objects relatively to the vehicle axis. In this connection, the 
misalignment angle to the current target object is determined by forming an average value of 
many measurements. It is true, though, that this average value formation functions 
satisfactorily only if the vehicle can follow the target object, a second vehicle traveling ahead, 
on a sufficiently long straight path, so that frequent measurements to the target object can be 
carried out. In the case of curves in the road or, also, uphill and down dale travel with 
changing angle of altitude, this method fails. 

On the other hand, in the case of the device for calculating and correcting a misalignment 
angle for a distance sensor according to European Bublished Patent ISliiiBl No. 0 782 
008 [&2|the angle of deviation from the center line is described, using a regression method. 
To do this, the angle is measured in each measurement cycle as a function of the distance 
from moving, or better still, from fixed radar objects. In particular in dense traffic, however, 
there are not enough suitable objects within sight range of the sensor, so that not enough 
measured values are available. Thus, each method has the disadvantage that the availability of 
measured values depends on the travel situation or the traffic situation, as the case may be. 

Summary p£the|; Of The! Invention 

By comparison, the distance sensor m^M^md^r^^atm according to the present invention 
^^^^^^^^^^^^^^^^^^l^^^^^^^^^^^^^^^^^^^^^^has the 
advantage that the reliability of the misalignment identification increases by the combination 
of a plurality of methods for determing a misalignment angle. 

A particular advantage as compared to the known related art is considered also to be that the 
measurements for the misalignment angle can be carried out, not only on a straight travel 
path, but also along a curve. More measured values result from this, which, in particular, also 
favor the formation of the average value. 

rilfinei^^ is 
especially advantageous that a yaw rate sensor is provided as a further instrument, whose 
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signals can be used for correcting trajectory curves. Since the yaw rate sensor detects the 
rotary motion of the vehicle about the vertical axis, it thereby also detects, in consideration of 
the driving speed, the bend in the travel path, or the curve, so that, from these data, 
appropriate angle calculations with respect to a vehicle driving ahead, which has been 
detected by the sensor, can be carried out The bend of a trajectory, in this connection, is 
looked upon as being the reciprocal value of the radius of the path, (in English: the 
curvature). 

With the aid of adaptive long-term filtering, quality indicators of the trajectory are ascertained 
from the ascertained misalignment angles of individual trajectories. With the aid of the 
quality indicators of the trajectory, reliability of the angle measurement is advantageously 
improved. In this case, for example, the determination of the quality indicators is made from 
the correlation value of a regression analysis of the curvature, the number of measured values, 
the length of the trajectory and/or the speed of the object. Since these parameters are 
relatively simple to measure, this also makes possible a simple calculation of the quality 
indicator. 

For the application of adaptive long-term filtering of the ascertained misalignment angle from 
individual trajectories, for example, a noise-optimized, linear, adaptive filter (e.g. a Kalman 
filter) is suitable, or a nonlinear filter in which the weighting of the individual measured 
values from the quality valuation is based on the quality indicators of the trajectory. 

A nonlinear filter can also be used as a suitable adaptive long-term filter, in which the 
weighting of the individual measured values is done from the quality appraisal. 

It is regarded as a special advantage that, with a positioning of the sensor outside the center 
line of the motor vehicle, the control system ascertains the misalignment angle with respect to 
the center line of the motor vehicle. That also causes the lateral angle arising from the center 
displacement of the sensor to be compensated for. 

It is also favorable that the ascertainment of the misalignment angle is weighted either as a 
function of the weighted average values of the yaw rate sensor or of the displacement from 
the center line. This yields an improvement in the signal quality, which improves the 
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robustness of the method for determining the misalignment angle, depending on the 
availability of the individual systems, since almost always at least one of the two methods 
receives suitable input data. Thereby one method advantageously compensates for the 
weaknesses of the other method. 

By weighting the averaged mean values of the two individual methods, one obtains an 
improved signal quality. 

Brief Description W£SMM®Mwmg& lo§M^^^WMM 
expl&ilM 

Figure 1 shows a first diagram with angle representations of ray paths 
Figure 2 shows a block diagram of a distance sensor [and]| 
Figure 3 shows a second diagram. 

Detailed Description [of;tl^ 

Figure 1 shows two motor vehicles 5, 6 which are traveling along on a road one behind the 
other at a distance d, the assumption being that motor vehicle 5 is behind motor vehicle 6. 
Furthermore, for reasons of clarity, only the middle rays of a sensor 2 are illustrated, not the 
entire radiation in the radiation range. It is also assumed in the exemplary embodiment that, 
in a first embodiment variant, a sensor 2 is mounted centrically on the front face of motor 
vehicle 5. It is aligned in such a way that its middle ray detects the rear end of motor vehicle 
6 driving ahead. On account of an assumed misalignment, the transmitted ray does not hit the 
rear end along the center line of motor vehicle 5, but rather displaced by an average angle 
alpha_sensor. For the sake of completeness, let it be mentioned that this reflected ray is 
received by a corresponding receiving device of sensor 2 and evaluated. Such an evaluation 
method is known, for example, from German Eublishefli Patent Applix:atidhlNo. 197 46 524 
£AH j. In the exemplary embodiment according to the present invention, the sensor is not 
positioned centrically but laterally displaced by a distance 

Yradar* With this sensor 2, now, the 
central ray b hits the projected center line of motor vehicle 5 at the rear end of target object 6 
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at an angle alpha_vehicle. From this positioning displaced from the center by the distance 
y radar , and the distance d to vehicle 6 driving ahead, an angle can now be determined according 
to the equation 

alpha_vehicle "= alpha_ sensor + y^^l d. 

This angle alpha_vehicle is ascertained by repeated measurements during the trip and suitable 
long-term filtering. Using this systematic deviation, the angle measurement of sensor 2 can be 
corrected. 

Carried out principally on a straight stretch of road, this method of compensating the 
misalignment angle by averaging the current target object angle over a plurality of 
measurements is less applicable in curves of the road, since there, the target "vehicle 6, 
driving ahead" is constantly changing the relative vehicle position with respect to sensor 2, 
because of the radius of curvature. To compensate for the error caused by^ the radius of 
curvature of the road, a yaw rate sensor 3 is provided on motor vehicle 5 to detect the change 
of direction of motor vehicle 5 about its vertical axis. Using the normalized signal from yaw 
rate sensor 3 and the angle alphavehicle, the result is an average deviation of the 
curvature-corrected angle according to the formula, 

daipha.object = average value(alpha_vehicle - 

d 2 *yaw rate/(2*vehicle speed)), 

where d^ _ object corresponds to the corrected angle and the yaw rate corresponds to the signal 
of yaw rate sensor 3. 

The averaging is to be carried out by a long-term low-pass filter. Furthermore, depending on 
the frequency of the averaging, for the magnitude da lpha object a quality value q ob j e ct can be given 
for the reliability of the angle. Since a curve 1 1 in a road can be set into a plurality of 
trajectories, there is a further possibility, when determining the misalignment angle, of 
applying a regression method known per se, as described, for instance, in European Published! 
Patent iiiiiliM No. 0 782 008 Jp2£ According to the present invention, as shown in 
Figure 3, in dependence on the distance to a moving, or better still, standing target object 10, 
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as, for example, a crash barrier part or a post, angles wl or w2 respectively, depending on 
position A or B of vehicle 5, are measured in curve 1 1 . From the distance d(ti) or d(tj) at 
point in time ti (position A) or tj (position B) of vehicle 5, for instance, to standing target 10, 
a lateral displacement y(ti) or y(tj) can be calculated by simple trigonometrical conversion. In 
contrast to the known method, this advantageously yields additional measuring points within 
sensor 2, for travel in a curve. It is therefore proposed by the present invention also to 
combine this method of regression analysis of trajectories with yaw rate signal 3, in order to 
compensate for the trajectory curvatures. The measured values thus obtained are averaged by 
adaptive long-term filtering of the ascertained misalignment angles of single trajectories. A 
noise-optimized, linear adaptive filter, for example a Kalman filter, can be used as the 
suitable filter. Alternatively, a nonlinear filter can also be used, in which the weighting of the 
individual measured value is founded on the quality assessment, which is based on quality 
indicators of the trajectory. The quality indicators are formed, for instance, from the 
correlation value of the regression analysis, from the curvature, number of measured points, 
trajectory length and object speed. 

As a result, a sliding long-term filtered misalignment angle d^a^ or a quality value q_traj is 
ascertained for the reliability of the angle, or rather is updated with each analyzed trajectory. 

Since this second method also does not always yield suitable trajectories, particularly in 
heavy columnar traffic, in an alternative solution both approaches are advantageously linked 
to each other. Depending on the reliability of the individual methods, the weightings of the 
approaches can be varied statically or dynamically. The linking of the two approaches takes 
place via a weighted average value of both individual methods. The weights are determined 
from the quality numbers: 

daipha = Gl (q_traj)*d alpha traj + G2(q_obj)*d alpha obj . 

where Gl(q_traj) and G2(q_obj) are the weights from the quality numbers. In this respect, 
Q_traj and q_obj form the quality numbers Qi. 

By the introduction of quality numbers Qi for each method, with a decrease in Qi in case no 
input variable is available for the method in the current cycle, and an increase in case input 
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variables are available, a simple possibility of selection was found as to which of the two 
methods is delivering, at the moment, the more reliable statement concerning the current 
angle measurement. Besides the improvement of the signal quality by the combination, the 
robustness of the methods increases also, since almost always at least one of the two methods 
contains suitable input data, that means, that one method compensates for the weaknesses of 
the other method. 

Figure 2 shows a block diagram of distance sensor 10, in which control system 1 is connected 
to sensor 2 and yaw rate sensor 3. There is also provided a compensation device for angle 
measurement 4, in which, among other things, the calculation of the angles, among other 
things, is carried out. The above-named calculations are preferably made with a program that 
is run by the microcomputer of control system 1 . 
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Ilill^^ H distance sensor having a sensor for a motor vehicle in 

which |ij[ei(iIHi| provided by which [Msaliggent]; gnmenti angles and 

trajectory curvatures can be compensated for during travel not only on a straight road but also 
along curves. In a sensor [pjji mounted displaced from the center line of the vehicle, an angle 



(alpha_sensor) is measured which cuts the projected center line of the motor vehicle (;(5);|at 
1 0 the target object, a vehicle 



\ driving ahead. By the additional use of a yaw rate sensor| 
curve curvatures of the road are also compensated for, so that angle and distance 
measurement can also be made along curves. 
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